#include <stdio.h>
#include <conio.h>
#include <string.h>

typedef unsigned char BYTE;

void LShift(BYTE buf[100],int len)
{
     int newhbit,oldhbit,i;

     oldhbit=buf[0]/0x80;
     for(i=len-1;i>=0;i--)
     {
	 newhbit=buf[i]/0x80;
	 buf[i]<<=1;
	 buf[i] ^= oldhbit;
	 oldhbit=newhbit;
     }
}

void GenCRC(BYTE *data,BYTE *crc,int len)
{
     int bitlen,hbit;
     BYTE buf[100];

     memcpy(buf,data,len);	buf[len]=buf[len+1]=0;	len+=2;
     for(bitlen=len*8;bitlen>16;bitlen--)
     {
	 hbit=buf[0] & 0x80;
	 LShift(buf,len);
	 if(hbit)
	 {
	     buf[0]^=0x80;	buf[1]^=0x05;
	 }
     }
     memcpy(crc,buf,2);
}

void AppendCRC(BYTE *buf,int len)
{
     BYTE crc[10];

     GenCRC(buf,crc,len);
     memcpy(buf+len,crc,2);	buf[len+2]=0;
}

int CheckCRC(BYTE *buf,int len)
{
     BYTE crc[10];

     GenCRC(buf,crc,len);
     if(crc[0]==0 && crc[1]==0)
	return 1;
     else return 0;
}

int main()
{
     BYTE data[100],crc[100],res;

     printf("Please Input String: ");
     scanf("%s",data);
     GenCRC(data,crc,strlen(data));
     AppendCRC(data,strlen(data));
     res=CheckCRC(data,strlen(data)+2);
     printf("CRC is : %02X%02X\n",crc[0],crc[1]);
}
